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!\fletod fttr robot 



TEKNISKT OMRADE 

FcSreliggande uppfixining hanfor sig till en metod f&r, en anordning f8r och anvandning av 
10 lagesmatning vid synkronisering av en roboi enligt den i ingressen rill patenrkrav 1 beskrivna 
typen. 

TEKNIKENS STANDPUNKT 

En industrirobot ska under drift uppfylla hoga krav pi precision och noggrannhet, 
15 Industriroboten utfor bestSmda reproducerbara rOrelser 6ver en programstyn, medelst 
elektriska motorer drivet lanksystem. Storleken av de enskilda drivgruppernas rorelse sryrs 
och overvakas <3ver en elektriskt vigmatsystem. Drivsystemets och vagmatsystemets 
nolistallningar m&ste OverensstSmma och pi nytt pitraffas vid awikelser. En industrirobot har 
dSrmed behov av en anordning ffcr exakt och upprepbar installning av robotens raotordrivna 
20 lanksystem. Det fir nfidvtodigt an kalfbrera en robot ftr an kunna uppfylla ovaruiSmnda krav 
pi precision och noggrannhet och efter driftsuppeh&ll och service &r det nSdvandigt an 
synkronisera roboten fifcr an den ska klara ovannamnda krav. 

Kalibrera avser hSr art initiera en robots konfiguration vid igSngsatming. Syftet Sr an finna 
25 robotens exakta konfiguration (0-lage / kalibreringslage) vid tiden for kraftpislag och initiera 
den kontrollerande delen av styrsystemet i enlighet darmed. 

Synkronisering avser har komroll eller installning av roboten mot 0-lager / kalibreringsiaget 

efter serviceuppeh&ll ( tex motorbyte ), driftsstopp, sammanstotning och dylikt. * 

30 

Industrirobotar arbetande med h6g noggrannhet ar utrustade med servostyrda motorer. F6r an 
kontrollera en motor miste en sensor m'iia det exakta lager ay motoraxelns vinkellage i 
realrid, I sevomotorer anvSnds lagesinformation tillsammans med vinkelhastighet i en 
Sterforingssystem f5r an nollstalla skillnader mellan ffirbestSmt och aktuellt lage. 
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Lagesinforraationen kan inte anvandas for an konirollera roboten om inie mamingarna speglar 
robotens vexkliga position. MSlet for kalibrering Sr darfor an initiera mamingarna rill de$s 
"sanna/verkliga" varden. 

5 Vid arbete med industrirobotar uppkommer darmed behovct av en metod for lagesrnatning an 
anvandas vid kalibrering och synkronisering av en robot. 

Den amerikanska paientskriften US, A, 4 419 831 anger en anordning vilken m5jligg6r en 
kalibrering ay ett lanksystem, vilken kan bringas an noggrant overensstamma med 

10 kalibreringen av en eiektriskt vSgmatsystem ocksi efter mbyte av driv- respektive 
vagmatsystemdelar. I en rorlig av tvi samraanhfirande lankdelar Sr en fordjupning eller 
RSrhSjning anordnad och i en tillhQrande andra lankdel ar en sryrning f5r ett finmatande 
avkanningsinstrument installban och fixerban anordnat, vilket instruments kannarelement 
indikerar kalibreringslager / 0-liget vid relativrdrelse av de bida lankdelarna genom 

15 bestamning av fSrdjupningens eller forhojningens minimum respektive maximum. Syftet med 
matmetoden ar an ft mfijlighet an efter utbyte av marsystem eller manipulator anv&nda 
samma program. 

Serviceuppehiill och andra driftssropp betyder storning av produktionslinjer och utebliven 
20 produktion, vilket medffcr stora oonskade kostnader. Det ar darfBr av storsta vikt an tiden Sir 
driftsstopp minimeras. Eftersom roboten m&ste kalibreras / synkroniseras efter varje 
stillestSnd ar det vikrigx an dena gfir snabbt. Det ar samtidigt av stSrsta vikt au metoden ar 
enkel, noggrann och har god repercrbarhet. Darmed uppstSr behovet av en noggrann, enkel 
och snabb metod fSr Ugesmatning. 
25 Dena behov kan inte metoden i den amerikanska patemskriften uppfylla. 

REDOGORELSE FOR UPPFENNINGEN 

30 En robotsystem innefanar flera delsystem bland annat manipulator och styrsystem. 
Manipulatorn definieras som de lankarmar, leder, transmissioner och drivdon som ingSr i den 
mekaniska armen. Styrsystemet genererar rtfrelser hos manipulatorn genom servosryming av 
de enskilda drivdonen samt definierade r6relser genom en styr- och interpoleringsmodell av 
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manipulaxoms fysiska uppbyggnad. I det foljande avser besitamingen "robot" en robotsystem 
innefanande bland annax manipulator och styrsystem definierade enligt ovan. 

Vid rillverkning ffcrses roboien med en datorprogram vilket innehailer lagrade koordinater 
5 vilka moisvarar forprogramnierade punkxer i rymden. Roboten ulformas si an en operator pa 
en tangentbord kan irycka pi en tangent varvid signaler gSr till robotens olika delar och styr 
dern an leta upp de p& ffcrhand bestSmda lagena och stalla in sig darefter. Man kan beskriva 
det med an roboien konfigureras till 0-lage / kalibreringslage. 

Roboten konfigureras till kalibreringslage enligt ovan. Darefter kalibreras roboten med tex en 
10 extern metod, vilket ger kalibreringsvarden fbr respektive rotarionsaxel, vilka utgi>r 
referensvSrden som matas in i styrsystemet och sparas. 

For an uppfylla ovannamnda krav pa en noggrann lagesmaming av roboten ar en forsta 
robotdel forscdd med en fysiskt mfcl. En vid den f&rsta robotdelen rOrligt flstad andra robotdel 
15 innefattar en sensor. Rdrelsen mellan robotdelama Sr translatorisk eller roterande. Med hjSlp 
av sensom detekteras m41ets lage vilket ger offsetvinkeln a. 

En installerad robot har darmed en kalibreringsvarde och en offsetvinkel a sparade fBr 
respektive rotationsaxel. Roboten kan startas och k5ras tills den av n&gon anledning stoppas J 
20 stannar. N£r nodvandiga iigfirder har vidtagits och det £r dags an starta roboten igen, mistc 
robotens synkroni s eringslage kontrolleras. Detta innebar an kalibreringsprogrammet kors, 
roboten stailer in sig i 0-lage / kalibreringslage och milens lage mats ffir respektive axel, en 
vinkel da beraknas och jamfors med den sparade offsetvinkeln a. 

25 Differensen d mellan uppmana vinkeln da och offsetvinkeln a beraknas och presenteras som 
offset av TCP (Tool Centre Point). Den beraknade differensen d visas pi en 
programeringsl&das skarmbild. V&rdet p& d visas grafiskt p& displayen och jfimfbrs med en 
forbestamt gransvarde. An vardet pi differensen d ligger tinder grSnsvardet betyder an 
roboten ar klar an tas i drift. Om daremot vardet p£ differensen d Sverstiger grinsvardet 

30 innebar det an robotens konfiguration inte langre Sverensstammer med de sparade 
kalibrerhigsvardena. I det laget m&ste man b5rja om genom an konfigurera och kalibrera 
roboten med tex en extern metod fSr an f& nya kalibreringsvarden ftSr 0-laget. Darefter 
fortsaner man med an uppmata ny offsetvinkel a och vidare enligt ovan. 
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Syftei med fSreliggande uppfinning ar siledes att istadkomma en merod med vilken man 
snabbt. enkek och med hcig noggrannhet kan synkronisera en robot. 

Losningen enligi uppfcnningcn ar an anordna en fysiskt mil pk den rorliga delen av roboren 
5 vid respektive robotaxlar och vid forflyttning av den r6rliga delen fram och tillbaka, med en 
givare aviasa Stminstone tvi med rdrelsen itskilda distinkia lSgen hos milet, berakna 
minlaget / medelvardet och infora vardet i styrsystemet. 

Besia mnin gen robotaxel avser robotens rfirelseaxlar fbr endera rotations- eller 
translarionsrfirelser 

10 

I den anffirda amerikanska patentskriften uiformas milet som endera en V-fonnad 
fordjupning eller fbrhdjning och givaren miter morsvarande minimum- och maximum 
) punkter Utformningen av milet till en spets medfor vissa nackdelar. En spets ar lSn att skada. 

Beroringsgivaren samt hantering av axlar i 6vrigt ger ett slitage pi spetsen vilket inverkar 
15 menligi pi noggrannheten. Vidare anges inte mfijligheten an lagesmSta en mil vid 
translatorisk rfirelse. 

Att med berfiringsgivare mala laget fttr en spets 2r mStningstekniskr svirt- En spets har tvi 
flanker och med en berdringsgivare uppst&r glidproblem utefter cna flanken oavsen om del ar 
en f5rh6jnmg eller fordjupning. En beraringsgivare, som User av laget for spetsen av en 
20 spetsigt mil vilket passerar givaren fram och tillbaka, visar en vSrde med inbyggda mStfel pi 
grund av svirigheten an dels folja spetsens yta och dels an avgora exakt var spetsen befinner 
sig. En trubbigare spets minskar glidproblemet men ger inte ett lika tydligt spetsiage att kanna 
av. 

Att med en berflringsfri givare mata laget fbr en spets kraver en dyr och komplicerad givare 
^ 25 fbr att fi tillfbrlitiiga matresuliat. Dessutom stalls det stora krav pi precisionen i utformningen 
av spetsen, vilket medfbr extra kostnader. Givaren bfir dessutom ha en jSmftreisevis stdrre 
aviasningsfalt, fbr an kuima aviasa en spets. Givaren kraver siledes urrymme i en redan 
mycket tring och kompakt konsrruktion. 

30 Ffir an minimera ovannamnda nackdelar ar fttreliggande uppfinning anordnad med mil 
utformade med tvi eller flera disrinkr detekterbara ffcrindringar. I det nedan beskrivna 
utRSringsexemplet ar milet mformat som en frist spir. En frast spir Sr uppbyggr av 
. . itminstone rvi spr&ngvisa niviskillnader i form av klackdelar. 
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An med en berfiringsfri givare mata laget for en klackdel ar mMmingstekniskt ISU. Klackdelar 
hax springvisa och tvfira niviforandringar vilka ar lana an registrera med forh&Uandevis enkla 
och billiga givare. Aven med en berdringsgivare ar det lan att mata laget f5r en klackdel, 
vilket ger en momentan niviffcrandring. 

Nar lager for en spir ska avlases och spirets klackdelar passerar fram och rillbaka framfor 
givaren avlaser givaren laget for tvi motstiende klackdelar vid varje passage. I ena matiaget 
sker niv&fbrandringen uppit och i andra mailaget sker nivifbrandringen nedit. Ur matteknisk 
synvinkel finns det rnatfel inbyggda i varje matutmsming. Genom an i enlighet med 
uppfinningen avlasa tvi l£gen och berSkna en minlage minskar matfelet och 
mStnoggrannheten okar. Spiret anordnas si an dess vaggar utbreder sig i en riktning vinkelrat 
mor rflrelseriktningen bide vid translations- och rotationsr6relse. Mamoggrannheten sjunker 
om riktningen pi spirets vaggar inte bildar rat vinkel med rtfrelseriktningen. 

An i enlighet med uppfinningen utforma m&let som en frast spir ar dessutom enklare, 
billigare och stiller inte samma krav pa precision jamfbrt med det spetsiga milet i den 
amerikanska patentskriflen. En frast spir stir emot slitage pi en mycket tillfredsstSllande sin. 
En annan praktisk fordel ar an spiren hos respektive axlar inte behSver vara idenriska. 

FIGURBESKRTVNING 

Uppfinningen kommer an forklaras narmare genom beskrivning av ett utforingsexempel 
under hanvisning till bifogadc riming, d3r 

fig 1 visar en indusmrobot innefaitande en styrsystem, 

fig 2 visar en mil i form av en spir med tvi distinkta begransningar samt en givare, 

fig 3 visar ett mil i form av en upphojning med tvi disrinkta begransningar samt en givare, 

fig 4 visar en grafisk itergivning av dc uppmana vinklarna (a) och (da) i f8rhillande till 0- 
laget / kalibreringlMget. 
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BESKRIVNING AV UTFORINGSEXEMPEL 

En industrirobot 1 ar urrustad med en styrsysiem 2 (fig 1). Den rfirliga delen 3 av roboten 1 ar 
pa respekrive robotaxel forsedd med ett fysiskt mil 4 och pi motsvarande robotaxeln 
uppcagande delen 5 ar en sensor 6 anordnad. Mile! 4 utgfirs av en frast spir vilket har rvi i 
huvudsak vertikala vaggar 4a och 4b. Spiret ar utfonnat med tvSra niviskillnader i fonn av 
klackdeiar (7) (fig 2). 

Anordningen syftar enligt ovan rill an kontollera / maxa en bestami lSge 4c hos milet 4 pi den 
rfirliga delen 3 av roboren 1 i fbrhillande till en kalibreringsvarde for respekrive robotaxel. 
Genorn an kdra en i sryrsysiemei inmatat datorprogram f5r kalibrering kommer programmer 
an beordra den rorliga delen 3 an passera sensor 6 i den ena eller andra rotationsrikmingen 
samiidigt som sensom kanner av rnilets lage genom an detektera laget for de tvi distinki 
detekierbara fbrtodringaraa 4a och 4b, beraknar minpunkxen 4c mellan de rvi fbrandringama 
och fir fram en medelvarde pi en vinkel, offsecvinkel a (fig 4). 

I figur 4 visas kalibreringsliget / 0-laget 0 och offsetvinkeln a. Dessutom visas en enligt ovan 
uppman vinkel da, som ar stdrre in offsetvinkeln a. Om det firms en differens mellan den 
uppmarta vinkeln da och offsetvinkeln a betyder det an n&got har ham med robotens 
konfiguration. Avslumingsvis ingir dirfor an bedoma om differensen ar acceptabel eller inte, 
vilket redan ar beskrivet i redogorelsen for uppfinningen. 

Nar roboten kalibreras altemaiivr synkroniseras sker kalibreringen av alia axlar en i taget. 
Alremativt kan man linka sig an kalibrera alia samtidigt. 

ALTERNATTVA UTFORMNINGAR 

Anordningen enligt uppfinningen kan aven utformas med milet anordnat pi den robotaxeln 
upptagande delen och givaren anordnad pi den rfirliga delen i respekrive robotaxel. 

Vid bedSmningen om differensen d ar accepiabel eller inte kan beddmningen programmeras 
in i sryrsystemet si an beddmningen sker automatiskt. Endera blir det klanecken an stana 
roboten eller ocksi order an kalibrera om den. 
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en dppning for an hanga in en 16s sensor i. 

Sensom kan Sven vara en beroringsgivare eller en beroringfri givare. 

M&lex kan aven vara en upphojning med ioninsione xvi. i huvudsak vertikala sidon 

5 

M&lets distinki detekterbara forandringar kan uigSras av en flertal sprfingvisa 
smUcoirfBiSndringar. 

Den rorliga delen i respektive robotaxel kan under lSgesmamingen fSrflynas endast it en h&ll. 
10 MSmingen i del hSr fallec ger and& i det nSimaste likvardigt resulxat som vid fSrflytming av 
den rOrliga delen fram och tillbaka. 
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I Metod for synkroniscring av en robot (1) som innefanar en siyrsystem (2), en forsia 
roboidel (3) och en vid den fttrsta robotdelen (3) rorligt fastad andra robotdel (5), varvid 
laget hos en mil (4) anordnat pi den fbrsta roboidelen (3) bestams vid passage av en hos 
den andra roboidelen (5) anordnad sensor (6) och j&mfors med en kalibreringslage i 
styrsysremet, kannetecknad avati milet (4) bringas an innefana en flercal 
disiinki deiekterbara fSrindringar (4a) och (4b), an de distinkt deiekterbara 
forindringarna avkinns av sensom (6), an milets lage (4c) beraknas och an det 
beraknade v&rdec infdrs i scyrsysiemei. 



2 Metod enligt patenikrav 1, kannetecknad av ande destinkt deiekterbara 
fbrandringarna utgcSrs av springvisa smikrurforandringar. 



3 Metod enligi patenikrav 1 , kannetecknad av an mileis (4) lage avlfises med en 
sensor (6) i form av en berbringsfiri givare. 



4 Metod enligt patenikrav 1, kannetecknad av an milets (4) lage avlases med en 
sensor (6) i form av en berOringsgivare. 



5 Metod enligt nigot av fbregiende paiemkrav , kannetecknad av an milet (4) 
utforxnas som en spir med huvudsakligea vertikala vaggar (4a) och (4b). 



6 Metod enligt patenikrav 1, kannetecknad av an milet (4) utformas som en 
upphojning med huvudsakligen vertikala sidor (4a') och (4b'). 



7 Anordning for synkronisering av en robot (1) som innefanar en siyrsystem, en fbrsta 
robotdel (3) och en vid ftJrsta roboidelen (3) rorligt fastad andra robotdel (5), vilken 
anordning innefanar en mil (4) anordnat pi den forsia robotdelen (3) och en sensor (6) 
anordnad pi den andra robotdelen (5) kannetecknad av an milet (4) innefanar 
en flercal av sensorn (6) disiinkt deiekterbara forindringar. 



8 Anordning enligt patenikrav 7,kannececknad av ande distinkt detekierbara 
forandringarna uig6rs av momeniana niviskillnader i form av klackdelar (7). 



9 Anordning enligt patenikrav 7, kannetecknad av an milet (4) ir utformat som 
en spir med tvi huvudsakligen vertikala vaggar (4a) och (4b). 
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10 Anordning enligt patentkrav 7, kdnaeieckDad av an milet (4) ar utformar som 
en upphdjniag med cvi huvudsakligen vertikala sidor (4a) och (4b) 

1 1 Anvandning av en raetod enligi n&got av patemktaven 1-6 eller anordning enligt n£go« av 
kraven 7-10 vid synkronisering av en industrirobot. 
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5 SAMMANDRAG 

Meiod f5r synkronisering av en robot, dar ett mil Sr anordnai pi den rSrliga delen av.roboten 
vid respektive robotaxlar. Den rorliga delen roieras fram och tillbaka och samridigt avlaser en 
sensor minst rva distinki dexekxerbara ffcxfindringar hos mftlex. Mittliget for milei beraknas 
10 och fors in i scyrsystemet. 



(fig 2) 
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